Inverse Kinematics for Modular Reconfigurable Robots

Inverse kinematics solutions of a reconfigurabie robot system built upon a collection of standardized components is dificult to obtain because of its varying configuration. This paper addresses the formulation of a generic numerical inverse kinematics model and automatic generation of the model for arbitrary robot geometry including serial type and branching type geometry. Both revolute and prismatic types of joints are considered. The inverse kinematics is obtained through the di@erential kinematics equations based on the Productof-exponential (POE) formulas. The Newton-Raphson iteration method is employed for solution. The automated model generation is accomplished through the introduction of Assembly Incidence Matrix (AIM) representation of a modular robot assembly configuration and the related accessibility matrix and path matrix. Examples of the inverse kinematics solutions for different types of modular robots are given to demonstrate the applicability and effectiveness of the proposed algorithm.